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Small  rotary-wing  UAVs  are  susceptible  to  gusts  and  other  environmental  disturbances 
that  affect  inflow  at  their  rotors.  Inflow  variations  cause  unexpected  aerodynamic  forces 
through  changes  in  thrust  conditions  and  unmodeled  blade  flapping  dynamics.  This  pa¬ 
per  introduces  an  onboard,  pressure-based  flow  measurement  system  developed  for  a  small 
quadrotor  helicopter.  The  probe-based  instrumentation  package  provides  spatially  dis¬ 
tributed  airspeed  measurements  along  each  of  the  aircraft-fixed  axes.  Lateral  and  vertical 
windspeed  estimates  enable  the  development  of  disturbance-tolerant  flight  control  strate¬ 
gies.  The  focus  of  this  paper  is  vertical  flow  disturbances  such  as  those  caused  by  the 
downwash  of  a  second  vehicle.  Real-time  velocity  measurements  are  incorporated  into  a 
recursive  Bayesian  estimator  to  localize  a  nearby  rotorcraft  using  its  downwash.  A  path 
planner  developed  for  proximity  flight  is  demonstrated  through  indoor  flight  testing  with 
multiple  vehicles  to  safely  guide  an  instrumented  quadrotor  around  the  downwash  of  nearby 
rotorcraft. 


Nomenclature 


u,v,w  Velocity  components,  m/s 
Lu,v,w, b  Velocity  calibration  factor 
Pi  Port  pressure,  Inches  of  Water 
p  Air  density,  kg/m3 

/ 3  External  source  location  vector 

z(tk)  Flow  speed  measurement  vector 
A  Posterior  scaling  constant 

t  Time,  s 

p  Dynamic  viscosity 

Wo  Velocity  constant 

r  Radial  distance  from  center  line 

uXjy  Control  input 

K  Control  gain 

J  Cost  function 

kj  Optimazation  weighting  variable 

x ,  y  Quadrotor  position 

Subscript 

i  Probe  number 

k  Time  step 

8  Disturbance  source  co-ordinate 
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I.  Introduction 


By  using  four  independent  rotors  to  provide  lift  and  control  moments,  the  quadrotor  helicopter  provides 
researchers  with  a  small,  mechanically  simple,  and  effective  vertical-flight  platform.  Typically,  the  lift  and 
resultant  torque  due  to  each  rotor  can  be  approximated  with  simple  aerodynamic  models.  Although  these 
models  have  proven  to  be  adequate  in  low  advance-ratio  flight  conditions,1  they  cannot  account  for  the 
flow  conditions  associated  with  high-speed  flight  or  the  presence  of  large  disturbances  such  as  wind  gusts  or 
downwash  from  nearby  rotorcraft.  Real-time  measurements  of  the  flow  field  around  a  flying  vehicle  provide  a 
description  of  the  flight  conditions  that  would  otherwise  be  impossible  with  only  inertial-based  instruments. 

This  paper  introduces  a  pressure-probe  flow  measurement  system  developed  for  a  small  quadrotor.  The 
design,  fabrication  and  calibration  of  the  instrumentation  package  are  presented  along  with  data  from  re¬ 
motely  piloted  flight  trials  using  motion-capture  based  positioning  data.  As  a  demonstration  of  the  capabil¬ 
ities  afforded  by  onboard  flow  sensing,  a  strategy  for  avoiding  the  downwash  of  a  neighboring  rotorcraft  is 
proposed. 

Assimilating  vertical  flow  field  measurements  with  a  Bayesian  estimation  algorithm  detects  and  localizes 
the  source  of  vertical  flow  disturbances  for  use  in  a  flight-path  planner  developed  for  proximity  flight.  The 
path  planner  minimizes  a  cost  function  that  drives  the  vehicle  to  a  desired  waypoint  while  avoiding  the 
vertical  downwash.  Test  results  from  indoor  experiments  with  two  quadrotors  operating  at  different  altitudes 
showcase  the  capability  of  the  flight  planner  to  generate  trajectories  that  successfully  avoid  the  downwash 
of  a  second  rotorcraft. 

The  contributions  of  the  research  described  in  this  paper  are:  (1)  implementation  of  an  onboard  flow 
sensing  instrumentation  system  that  uses  an  array  of  distributed  pressure  sensors  to  produce  measurements 
of  the  surrounding  flow  field;  and  (2)  a  flight-path  planner  that  estimates  the  surrounding  flow  field  in  order 
to  generate  a  safe  trajectory  to  the  desired  goal  location.  The  measurements  from  the  instrumentation 
system  are  used  in  a  recursive  Bayesian  estimator  to  estimate  the  position  of  another  quadrotor,  which  in 
turn  is  used  in  the  path  planner  for  guidance  and  control. 

The  rest  of  the  paper  is  as  follows.  A  brief  background  of  onboard  flow  sensing  for  small-scale  flyers  is 
provided  in  Section  II.  Section  III  describes  the  design  and  testing  of  the  air-speed  instrumentation  system. 
Section  IV  presents  a  recursive  Bayesian  estimator  that  estimates  the  position  of  a  hovering  quadrotor  using 
downwash  measurements.  Section  V  contains  results  from  experimenting  with  a  flight-path  planner  for 
proximity  flight.  Section  VI  summarizes  the  paper  and  ongoing  work. 

II.  Background 

The  use  of  flow  sensing  has  been  employed  with  great  success  on  naturally  evolved  flyers.2  Using  dis¬ 
tributed  measurements  of  relative  wind,  sufficiently  large  creatures  such  as  birds  align  themselves  with  their 
intended  direction  of  travel  and  account  for  the  effects  of  wind  gusts.  By  detecting  fine  details  of  the  ambient 
flow  field,  small  creatures  like  insects  improve  their  flight  performance  by  finely  tuning  their  flap  stroke  to  suit 
flight  conditions.2  Gewecke  and  Woike3  showed  that  directing  airflow  over  avian  feathers  could  cause  steering 
impulseOs,  and  as  shown  in  more  recent  work  by  Brown  and  Fedde,4  birds  have  the  necessary  sensor-feather 
mechanisms  in  the  wing  to  predict  stall  and  measure  airspeed. 

In  contrast  to  natural  flyers,  the  current  paradigm  of  small  UAS  instrumentation  is  to  integrate  inertial 
measurements  supplemented  by  (scalar)  airspeed.  A  five-hole  probe  providing  air-data  measurements  that 
include  airspeed,  angle  of  attack,  and  sideslip  has  been  successful  in  applications  involving  conventional  fixed 
wing  flight  within  the  traditional  flight  envelope.5”7  These  platforms  provide  a  baseline  capability  for  more 
advanced  tests  in  areas  such  as  cooperative  control8  and  ocean-borne  operations9  for  both  fixed-wing  and 
rotary-wing  vehicles.10, 11 

Seeking  improved  platform  performance,  researchers  have  looked  to  expand  the  notion  of  onboard  flow 
sensing  and  apply  it  to  various  levels  of  vehicle  control.  For  example,  flow  information  can  be  used  to  fine- 
tune  aerodynamic  parameters  for  performance.  Patel  and  Corke12,13  considered  the  time-domain  response 
from  a  high-bandwidth  pressure  sensor  to  predict  incipient  flow  separation  at  the  wing  leading  edge  and 
trigger  a  plasma  flow  actuator  to  alleviate  flow  separation. 

Flow  sensing  can  also  improve  flight  control.  Xu  et  al.14  implemented  arrays  of  micro-machined  shear- 

2  of  11 


American  Institute  of  Aeronautics  and  Astronautics 


stress  sensors  on  the  leading  edge  of  a  low  aspect-ratio  delta  wing.  The  sensor  system  was  developed  to 
support  flight  control  strategies  that  effected  aerodynamic  flight  control  through  boundary- layer  manipu¬ 
lation  by  Grosjean  et  al.15  The  AVOCET  project16  aims  to  continuously  tailor  the  pressure  distribution 
and  resulting  forces  and  moments  across  the  wing  using  advanced  micro-tuft  sensors  and  hybrid  fluidic  flow 
actuators.  Under  attached  flow  conditions,  NASA  has  supported  wind  tunnel-based  implementation  and 
testing  of  a  distributed  actuation  and  sensing  array  for  use  on  a  blended-wing-body  UAV,  using  a  series  of 
pressure  measurements  to  study  the  effectiveness  of  a  morphing  wing  control  strategy.17,18  More  recently, 
Watkins  et  al.  have  demonstrated  improved  attitude  control  of  a  small  fixed-wing  vehicle  in  turbulent  flow 
conditions  through  the  integration  of  pressure  sensors  embedded  in  the  main  wings. 

At  a  higher  level,  aerodynamic  sensing  provides  information  that  can  drive  vehicle  configuration  or 
guidance  decisions  based  on  flight  conditions.  For  example,  Cox  et  al.19  used  pressure  based  estimates  of 
the  lift  curve  above  an  airfoil  as  feedback  for  an  automated  cruise  flap.  Yeo  et  al.20  used  real  time  stall 
detection  through  pressure  sensing  to  change  controller  modes  on  a  small,  fixed-wing  UAV  during  transition 
between  forward  flight  and  propeller-borne  hover. 

The  work  presented  in  this  paper  seeks  to  expand  the  notion  of  onboard  aerodynamic  sensing  for  small 
rotorcraft  UAVs.  Additional  flow  information  across  the  rotors  improves  quadrotor  attitude  stabilization 
in  wind,21  while  also  detecting  environmental  disturbances  for  improved  trajectory  planning.  This  paper 
focuses  on  aerodynamic  sensing  as  an  enabler  for  improved  multiple  vehicle  operations,  which  often  require 
close-proximity  flight. 

Recently,  there  have  been  several  approaches  proposed  for  dealing  with  proximity  flight.21  24  For  example, 
in,21  a  nonlinear  controller  uses  an  estimate  of  the  wind  speed  to  compensate  for  a  rotor  downwash  impinging 
on  the  vehicle.  However,  the  controller  assumes  knowledge  of  the  structure  of  the  downwash.  Another 
example  is  Powers,24  where  a  controller  is  designed  to  compensate  for  minor  (1-2  m/s)  changes  in  airspeed 
due  to  quadrotors  operating  at  the  same  altitude.  In  both  examples,  the  external  wind  (or  an  estimate  of 
the  wind)  impinging  on  the  rotorcraft  is  assumed  to  be  available. 

External  wind  information  is  provided  in  this  paper  by  a  novel  probe-based  flow  measurement  package. 
Unlike  traditional  measurement  techniques  employed  on  small  rotors  such  as  hot-wire  anemometry12  and 
optical  velocimetry  methods,13,17,19  the  pressure-probe-based  approach  used  here  is  inherently  portable, 
rugged  and  well-suited  for  implementation  onboard  a  small  flight  vehicle.  The  instrumentation  system 
presented  in  this  work  is  capable  of  providing  flow  speed  measurements  below  5m/s  in  real  time,  enabling 
the  implementation  of  flowbased  guidance  and  control.  To  show  the  utility  of  the  instrumentation  system, 
we  design  a  flight-path  planner  to  avoid  downwash  of  another  quadrotor  while  simultaneously  directing  the 
vehicle  toward  a  goal  location. 


III.  Quadrotor  Instrumentation  System 

The  flow  instrumentation  system  shown  in  Fig.  1  uses  custom-built  pressure  probes  that  provide  flow 
information  through  differential-pressure  measurements.  A  single  top-mounted  airspeed  probe  takes  mea¬ 
surements  along  the  longitudinal  and  lateral  directions  of  the  vehicle  and  four  vertical-airspeed  probes  are 
mounted  uniformly  around  the  vehicle  outside  the  downwash  the  rotors.  A  two-port,  fore-  and  aft-facing 
configuration  allows  for  flow  speeds  under  5  m/s  to  be  measured  with  improved  signal-to-noise-ratio  as 
compared  to  a  standard  pitot-static  probe  configuration. 

The  instrumentation  packages  are  portable  and  easily  mounted  on  a  variety  of  small  quadrotor  vehicles. 
The  probes  are  constructed  out  of  aluminum  tubing  that  is  bent  to  form  two  to  four  pressure  ports  at 
each  tip.  The  probe  design  is  based  on  a  multi- hole  probe  for  propeller- wash  measurements.10  The  design, 
geometry  and  port  configuration  of  the  various  probes  is  shown  in  Fig.  1.  The  airspeed  component  across 
the  pressure  port  pairs  are  related  to  the  differential  pressure  measurement  by 


u  =  L,. 


l2Lb(P1-P2) 


v  =  Lv 


l2Lb(P4-P3) 


(1) 

(2) 
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Figure  1.  Quadrotor  flow  instrumentation  probe  locations  and  geometry. 


Wi  =  Lv 


l2Lb(Piil-Pii2) 


(3) 


where  the  scaling  factors  Lu,  Lv  and  Lw  are  determined  by  calibration  in  a  wind  tunnel  and  the  factor  L 5 
includes  the  effect  of  gravity  and  unit  conversion.  The  calibration  is  applied  onboard  and  a  moving  average 
filter  is  implemented.  (The  air  data  system  is  built  around  a  Freescale  Semiconductor  MK20DX256VLH7 
ARM  Cortex  M4  microprocessor  running  13bit  ADC  at  1kHz.  Honeywell  HSCDRRN001NDAA3  differential 
pressure  sensors  are  used  to  measure  probe  pressures,  and  processed  flow  speed  measurements  are  transmitted 
over  a  serial  port  interface.  In  flight,  Digi  XBEE  radios  are  used  to  transmit  measurements  to  a  ground 
station.) 


Figure  2.  Wind  tunnel  tests:  measured  longitudinal  and  lateral  airspeed  components 


The  directional  sensitivity  of  the  port  configuration  was  first  evaluated  through  wind-tunnel  testing.  The 
probe  is  mounted  on  a  rotating  stage  that  yaws  the  probe  in  a  constant  free  stream.  Measurements  from 
both  sets  of  ports  were  compared  against  idealized  wind  vector  values  at  each  probe  angle.  Fig.  2  shows 
that  the  probe  is  able  to  estimate  flow  direction  reasonably  with  maximum  error  under  15%  of  full-scale 
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deflection.  The  ability  of  the  instrumentation  package  to  provide  wind  vector  information  in  flight  was  also 
tested  using  remotely  piloted  maneuvers  in  an  indoor  motion-capture  facility.  A  Blade  350QX  was  flown 
diagonally  across  the  capture  space  to  generate  airspeed  along  the  body- fixed  lateral  and  longitudinal  axes. 
Wind  vector  measurements  taken  by  the  translational  probe  were  streamed  to  a  groundstation  and  compared 
against  ground-speed  data  from  the  motion-capture  system,  assuming  still  air. 


(a)  Longitidinal  component  (b)  Lateral  component 

Figure  3.  Remotely  piloted  flight  tests:  measured  longitudinal  and  lateral  airspeed  components 


Fig.  3  suggests  that  the  pressure-port  configuration  is  capable  of  providing  reliable  directional  velocity 
measurements.  Using  a  combination  of  one  lateral  airspeed  probe  and  four  vertical  downwash  probes,  the 
instrumentation  scheme  is  capable  of  providing  (relative)  wind  vector  information  over  the  body  of  the  vehicle. 
This  paper  focuses  on  using  the  vertical  wind  vector  measurements  to  sense  vertical  flow  disturbances. 

IV.  Vertical  Flow  Field  Estimation 

Vertical  flow  disturbances  affect  any  flight  vehicle  by  creating  transient  disruptions  to  aerodynamic  force 
generation.  For  multiple  rotorcraft  operating  in  close  proximity,  impinging  downwash  from  a  vehicle  op¬ 
erating  at  a  higher  altitude  causes  sudden  and  possibly  catastrophic  loss  of  thrust  from  the  affected  rotor. 
Knowledge  of  the  flow  environment  provides  a  flight  controller  with  the  data  to  accommodate  and  avoid  such 
disturbances.  This  section  summarizes  the  development  of  a  Bayesian  estimation  scheme  and  accompanying 
vertical  flow  field  model  that  uses  real-time  flow  field  measurements  around  a  quadrotor  to  localize  and  avoid 
the  downwash  from  another  quadrotor. 

Recursive  Bayesian  estimation  provides  a  probabilistic  framework  for  inferring  an  unknown  quantity  given 
a  set  of  measurements.21  An  estimator  is  used  here  to  continuously  update  the  most  likely  location  of  an 
external  source  of  downwash  based  on  a  set  of  vertical  flow  measurements.  The  location  of  the  external  source 
is  denoted  by  (3  =  (xs,ys),  where  (xs,ys)  are  the  inertial  coordinates  of  a  nearby  rotorcraft  operating  at  a 
higher  altitude  and  creating  a  region  of  accelerated  flow.  (We  assume  the  instrumented  quadrotor  knows  its 
own  inertial  position  too,  but  this  is  not  necessary).  Let  z(tk)  be  a  vector  of  noisy  windspeed  measurements 
taken  using  the  flow  measurement  system  at  time  £&.  The  probability  of  /3  being  the  center  of  a  vertical  flow 
disturbance  is 

p(P\z(ti),~,z(tk))  -  Ap(z(tk)\P)p(P\z(ti),..,z(tk-i))  (4) 

where  p(f3\z(ti)7 ..,  z(tk~  1))  is  the  posterior  probability  density  and  A  is  a  constant  to  give  the  posterior  a  unit 
integral.  The  likelihood  function  p(z(tk)\(3)  represents  the  conditional  probability  of  receiving  measurements 
z(tk~  1)  given  a  nearby  vehicle  located  at  coordinates  /3.  The  mode  $  of  (4)  is  the  maximum  likelihood 
estimate  of  the  source  of  downwash.  Suppose  there  are  N  spatially  distributed  probes  across  the  vehicle;  the 
ith  probe  has  the  likelihood  function  p(zl(tk)\/3),  where  zl(tk)  is  the  measurement  from  the  ith  probe.  The 
posterior  based  on  all  probe  measurements  is 
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(5) 


N 

p(/3\z(tk))  =  p(P\z(tx), z(tk- 1))  Y[p(zz(tk)\P), 

i=  1 

where  z{tk)  comprises  the  measurements  from  all  probes  up  to  and  including  time 

A  key  component  in  implementing  a  Bayesian  estimator  is  a  suitable  likelihood  function  that  translates 
measurements  to  information  of  the  environment  through  knowledge  of  the  expected  flow  field.  The  likelihood 
function  translates  a  vertical-velocity  measurement  to  information  pertaining  to  the  location  of  a  nearby 
vehicle  through  knowledge  of  the  downwash  it  generates.  Obtaining  a  simple  flow  model  that  adequately 
captures  the  key  characteristics  of  a  range  of  downwash  flow  s  is  challenging  as  a  rotor-driven  flow  field  is 
inherently  complex,  time-varying  and  characterized  by  a  number  of  unknown  parameters.  Also,  a  simple 
model  for  estimation  should  not  require  numerical  simulation  or  significant  prior  knowledge.  To  this  end,  a 
first-order  analysis  of  the  governing  flow  equations  is  employed  here. 

Consider  a  two-dimensional  flow  field  with  a  rotor  generating  thrust  along  the  2- axis.  Velocity  components 
w  and  v  he  along  the  z  and  y  coordinates  respectively.25  The  momentum  equation  in  the  2  direction  is 


dw  dw  dw  1  dp  p  ( d2w  d2w\ 

~di+W^+V^y=9z~Wz  +  ~p\d^  +  W) 


(6) 


where  p  is  air  density,  p  is  the  dynamic  viscosity  of  the  air,  and  gz  represents  body  forces  due  to  effects  such 
as  bouyancy.  The  following  set  of  assumptions  are  applied  as  follows:  (1)  the  mean  flow  field  is  unchanging, 
so  dw/dt  is  zero;  although  rotorwash  is  highly  turbulent,  a  rotorcraft  in  a  steady  flight  condition  will  generate 
a  steady  mean  flow  field  velocity.  (2)  Cross-stream  flow  is  small  compared  to  the  downstream  velocity;  this 
assumption  is  based  on  the  intuition  that  even  with  the  helical  structure  common  to  propeller-driven  flow 
s,  cross-stream  velocity  plays  a  secondary  role  in  thrust  generation.  For  simplicity,  only  the  thrust-aligned 
velocity  component  is  considered  and  dw/dy  is  neglected.  (3)  At  each  2  location,  the  stream- wise  variation 
in  w  is  small  compared  to  the  cross  stream  changes;  hence,  d2w/dz 2  is  zero.  (4)  Lastly,  bouyancy  and 
external  pressure  gradients  are  not  present,  so  gz  and  dp/dz  are  neglected. 

Eq.  (6)  is  further  simplified  by  linearizing  about  a  constant  peak  velocity,  VEo,  based  on  the  intuition 
that  center-line  flow  velocities  obey  a  1/z  decay.  The  result  is 


Wo 


dw 

dz 


p  ( d2w\ 
P  \  dy2  ) 


(7) 


Solving  (7)  in  cylindrical  coordinates  yields  a  Gaussian  velocity  profile  reminiscent  of  the  velocity  vari¬ 
ation  observed  in  established  turbulent  jet  profiles.26  The  expected  vertical  velocity  measured  at  a  lateral 
distance  r(/3)  =  yf(x  —  xs )2  +  (y  —  ys )2  and  a  downstream  distance  z  from  the  center  of  an  idealized  rotor- 
craft  is 


The  measurement  zl(tk)  of  the  ith  sensor  at  time  tk  is  assimilated  into  the  Gaussian  likelihood  function 

p(zz(tk) \/3)  =  exp((2:1  -  w)/a2),  (9) 

where  a2  is  the  variance  of  the  measurement  noise  (chosen  based  on  sensor  characteristics). 

To  validate  the  Bayesian  methodology  and  evaluate  the  performance  of  the  generalized  flow  model,  a 
series  of  ground-based  experiments  were  conducted.  A  common  32  inch-diameter  household  fan,  recast  as 
a  source  of  vertical  flow  disturbance,  generated  the  flow.  A  test  stand  suspended  the  airspeed  probes  over 
the  vertical  source  while  data  from  an  OptiTrack  motion-capture  system  provided  position  information.  To 
test  the  methodology  in  a  more  complex  flow  field  than  was  modeled,  experiments  were  conducted  within 
the  zone  of  flow  establishment  where  velocity  profiles  have  twin  velocity  peaks  near  the  center  line.27  Even 
though  this  flow  feature  was  unmodeled,  a  series  of  localization  tests  were  successfully  carried  out  using  a 
single  probe,  followed  by  a  set  of  tests  with  a  quadrotor  mockup.  The  quadrotor  mock-up  stand  is  shown  in 
Fig.  (4).  Velocity  measurements  were  taken  at  a  number  of  probe  locations,  simulating  a  series  of  trajectories 
within  the  flow  field.  The  spinning  rotors  simulated  the  self- noise  generated  in  flight. 
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The  idealized  flow  model  and  Bayesian  framework  provided  accurate  fan  location  estimates.  The  algo¬ 
rithm  typically  estimated  the  center  of  the  fan  to  within  2  cm,  or  under  3%  of  the  fan  diameter.  Results 
from  a  sample  test  run  are  presented  in  Fig.  (4)  showing  estimates  within  2%  of  fan  diameter  in  four  time 
steps.  The  colormap  shows  the  posterior  distribution  of  the  location  of  the  fan,  with  red  indicating  high 
probability  and  blue  indicating  low  probability.  The  green  and  red  asterisks  denote  probe  location  and  the 
red  circle  indicates  the  actual  location  of  the  fan,  unknown  to  the  estimator. 


Instrumented 

Quad-rotor 

Airframe 


Moveable  Test  Stand 


32  inch  Fan 


(a)  Test  Setup 


(b)  Position  1 


(c)  Position  2 


(d)  Position  3  (e)  Position  4 

Figure  4.  Quadcopter  mock-up  and  sample  localization  results 


7  of  11 


American  Institute  of  Aeronautics  and  Astronautics 


V.  Proximity  Flight  Experimental  Results 

This  section  showcases  the  utility  of  a  flow  sensing  and  control  system  for  proximity  flight.  The  scenario 
involves  multiple  quadrotors  operating  at  various  altitudes.  The  downwash  of  a  higher  quadrotor  causes 
extreme,  undesired  changes  in  attitude  and  altitude  of  a  lower  quadrotor  should  it  impinge  on  the  lower 
quadrotors  rotors.21  The  flight-path  planner  and  flow  measurement  system  were  implemented  on  the  lower 
quadrotor.  The  planner  uses  an  estimate  of  the  position  of  the  higher  quadrotor  to  determine  the  direction 
the  lower  quadrotor  must  travel  to  reach  a  desired  waypoint  while  avoiding  the  downwash  of  the  higher 
quadrotor.  The  flow  measurement  system  and  path  planner  were  validated  in  simulation  and  experiment. 

Consider  a  vehicle  with  the  dynamics 


x  =  ux  (10) 

V  =  Uy,  (11) 

where  x  and  y  are  the  coordinates  the  vehicle  and  ux  and  uy  are  control  inputs.  The  goal  is  to  design  ux 
and  uy  to  drive  the  vehicle  to  a  waypoint  and  avoid  the  vertical  jet  produced  by  the  higher  quadrotor.  The 
following  cost  function  J  incorporates  the  desired  goal  and  the  presence  of  a  vertical  flow  field: 

J(x,y,tk )  Up(z(tk)\(3)  +  kj\J (x  -  Xdji  +  (y  -  yd)2,  (12) 


where  (xa,  Vd)  is  the  location  of  the  goal  and  kj  is  a  weighting  variable.  Intuitively,  the  cost  is  high  when 
the  vehicle  is  far  away  from  the  waypoint  and/or  near  the  downwash  of  the  higher  quadrotor.  The  goal  is 
to  find  a  path  C  through  the  domain  such  that  the  integral  of  J  along  the  path  is  minimized.  Formally,  the 
problem  is  stated  as 

minimize 

U x  i^y 


/ 


J{x,y,tk)ds 


C 

subject  to  x  =  ux 


(13) 


y  =  Uy, 

where  ds  is  an  increment  along  the  path. 

To  decrease  the  computational  complexity,  a  receding  horizion  version  of  (13)  looks  only  one  time  step 
ahead.  In  this  case  the  cost  function  reduces  to 


Jrh  =  J(x,y,tk)  +  J(x  +  Ax,  y  +  Ay,  tk) 


(14) 


Since  the  first  term  on  the  right-hand  side  is  fixed  by  the  current  vehicle  location,  the  cost  function  is 
minimized  by  moving  in  the  direction  of  greatest  decrease.  Thus,  in  the  zero  limit  of  Ax  and  Ay,  (14)  is 
minimized  using  the  control 


-hf. 

(15) 

(16) 

where  K  is  a  control  gain.  This  choice  of  control  moves  the  vehicles  opposite  the  gradient  of  the  cost  function, 
i.e.,  the  direction  of  greatest  decrease  in  the  cost. 

The  algorithm  was  first  tested  in  simulation.  The  hovering  quadrotor  was  commanded  to  hover  at  an 
altitude  of  2.5  m,  and  the  instrumented  quadrotor  was  given  a  waypoint  at  (2.0,  0.0)  m.  Fig.  5  shows  the 
results  of  the  algorithm.  Each  subfigure  shows  a  snapshot  of  the  simulation  at  a  different  timestep,  starting 
from  the  initial  time  until  the  vehicle  reaches  the  goal.  The  colormap  at  the  bottom  shows  the  posterior 
distribution  for  the  position  of  the  hovering  quad,  with  red  and  blue  denoting  high  and  low  probability 
respectively.  The  black  dot  indicates  the  position  of  the  hovering  quadrotor,  the  green  dot  is  the  position 
of  the  instrumented  quadrotor,  and  the  red  X  shows  the  destination  of  the  instrumented  vehicle.  The 
trajectory  of  the  quadrotor  is  shown  as  a  white  line  on  top  of  the  posterior  distribution.  The  estimate  of 
the  position  of  the  hovering  quadrotor  is  shown  as  a  magenta  dot.  The  results  show  that  the  instrumented 
quad  travels  towards  the  waypoint,  then  diverts  once  it  detects  the  high  altitude  quadrotor  using  simulated 
flow  measurement  data.  Note  that  the  estimate  does  not  acheive  zero  steady  state  error  due  to  noise  in  the 
sensor  measurements. 
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y  (m)  5  5  x  (m)  y  (m)  5  5  x  (m) 


(c)  t  =  10  s  (d)  t  =  15  s 

Figure  5.  Trajectory  of  an  instrumented  quadrotor  in  proximity  flight.  The  colormap  indicates  the  posterior  distribution 
of  the  probability  of  the  hovering  quadrotor  location. 


To  validate  the  flow  measurment  system  and  proximity  flight  path  planner,  experiments  were  performed 
at  the  Naval  Research  Laboratory  in  the  Laboratory  for  Autonomous  Systems  Research  (LASR).  The  exper¬ 
iments  were  performed  in  a  motion  capture  testbed  in  the  Prototyping  Highbay  at  LASR,  which  is  150  by  75 
ft  and  equipped  with  115  Vicon  motion  capture  cameras.  Flight  tests  were  conducted  using  two  Ascending 
Technologies  Pelican  quadrotors.  The  Pelican  has  two  onboard  computers,  one  for  flight  stabilization  and  a 
Linux  computer  for  sensor  integration  and  control  calculations.  The  Linux  computer  runs  Robot  Operating 
System  (ROS),  which  is  a  message  passing  architecture  for  autonomous  robots. 

In  the  experiment,  the  high- altitude  quadrotor  was  commanded  to  hover  at  the  origin  at  an  altitude  of 
2.5  m.  The  instrumented  quadrotor  was  commanded  to  go  to  the  waypoint  (2.5,  0.0)  m  while  an  altitude 
of  1.5  m  from  five  separate  initial  conditions.  Fig.  6  shows  the  results  of  the  flight  test  for  all  of  the 
runs.  Fig.  6(a)  shows  the  trajectory  of  two  quadrotors.  The  black  X  indicates  the  position  of  the  hovering 
quadrotor  and  the  green  X  shows  the  desired  waypoint.  The  dashed  black  circle  shows  the  approximate 
area  where  the  downwash  of  the  hovering  quadrotor  is  significant.  The  dashed  red  trajectory  shows  the 
path  of  the  vehicle  with  the  flow  measurement  system  and  control  disabled  to  show  the  nominal  trajectory 
the  vehicle  takes.  (Note  that  for  safety  reasons  this  trajectory  was  implemented  without  the  presence  of 
the  hovering  quadrotor.)  The  other  trajectories  show  the  quadrotor  with  the  flow  measurement  system  and 
control  enabled.  Fig.  6(b)  shows  the  measurements  (colored  dots)  taken  by  the  flow  measurement  system 
for  the  red  colored  run  as  well  as  the  estimation  error  (solid  lines)  of  the  hovering  quadrotors  position  for  all 
five  runs  that  included  the  hovering  vehicle  (the  estimates  are  color  coded  to  match  the  trajectories  in  Fig. 
6(a)).  Fig.  6(c)  shows  the  x  and  y  position  estimates  of  the  hovering  quadrotor  for  the  red  run. 

The  experiments  show  the  necessity  of  the  flow  measurement  system  and  the  flight-path  planner.  A 
vehicle  without  the  combined  system  travels  in  a  straight  trajectory  towards  the  waypoint,  as  indicated 
by  the  dashed  red  line  in  Fig.  6(a).  This  would  place  the  vehicle  directly  in  the  downwash  of  the  higher 
quadrotor.  The  vehicle  with  the  flow  measurement  and  flight-path  planner  detects  the  downwash  of  the 
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Figure  6.  (a)  Trajectory  of  the  quadrotor  from  five  separate  initial  conditions  with  the  hovering  vehicle  located  at  the 
origin  and  one  initial  condition  without  the  hovering  vehicle,  (b)  measurements  from  the  airspeed  probes  from  red 
trial  and  hovering  quadrotor  estimation  error  for  all  five  runs;  (c)  position  estimate  of  the  hovering  quadrotor  for  the 
red  run  (middle  trajectory) 


higher  quadrotor  at  approximately  t  =  3.0  seconds  for  the  red,  blue,  and  green  trajectories,  as  seen  in  Fig. 
6(b).  As  soon  as  the  sensor  measures  a  positive  airspeed,  the  error  in  the  estimate  of  the  position  of  the 
higher  quadrotor  drops  to  close  to  the  desired  position.  Note  that  the  error  in  the  estimate  is  likely  due  to 
a  combination  of  sensor  noise  and  uncertainty  in  the  choice  of  parameters  in  the  likelihood  function.  Once 
the  estimate  of  the  higher  quadrotors  position  converges,  the  instrumented  vehicle  maneuvers  to  avoid  the 
downwash,  as  shown  by  the  red,  blue,  and  green  trajectory  in  Fig.  6(a).  The  position  estimates  for  the 
red  run  seen  in  Fig.  6(c)  show  how  the  estimate  converges  to  near  the  correct  value  when  the  instrumented 
vehicle  passes  close  to  the  hovering  quadrotor.  Note  that  the  estimate  drifts  away  once  the  downwash  is  no 
longer  detected.  This  is  due  to  process  noise  that  is  added  to  the  recursive  Bayesian  filter  to  avoid  probability 
collapse.  The  magenta  and  black  trajectories  do  not  travel  close  enough  to  the  hovering  quadrotor  to  even 
detect  the  downwash.  This  is  apparent  in  both  Figures  6(a)  and  6(b)  as  the  vehicle  does  not  maneuver  to 
avoid  the  downwash  and  the  estimate  never  converges. 

VI.  Conclusion 

An  onboard  flow  sensing  concept  for  quadrotor  platforms  is  introduced  along  with  an  instrumentation 
package  based  on  a  set  of  custom  wind-velocity  probes.  Data  from  ground-based  and  remotely  piloted  tests 
show  that  the  system  is  capable  of  providing  accurate  wind  vector  measurements  in  flight.  A  flight  path 
planner  is  designed  to  use  these  measurements  to  generate  an  estimate  of  the  surrounding  flow  field  in  the 
presence  of  a  second  rotorcraft;  safe  trajectories  avoid  hazardous  downwash  conditions.  The  flow  measure¬ 
ment  system  and  flight-path  planner  were  tested  in  simulation  and  in  a  motion  capture  testbed.  Experiments 
showed  that  the  vehicle  was  able  to  successfully  avoid  the  downwash  of  another  quadrotor  and  reach  a  desired 
goal.  In  ongoing  work,  we  are  developing  an  autopilot  that  incorporates  flow  speed  measurements  into  the 
flight  stabilization  controller,  allowing  us  to  stabilize  quadrotor  attitude  in  the  presence  of  wind  gusts. 
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